Grade Control for Compact Machines